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REPORT SUMMARY 


This is a semiannual report presenting the research results obtained from the research 
grant entitled “Development of Advanced Control Schemes for Telerobot Manipulators,” 
funded by the Goddard Space Flight Center (NASA) under a research grant with Grant 
Number NAG 5-1124, for the period between February 1st, 1990 and July 31, 1990. 

A Cartesian- space control scheme is developed to control the motion of kinemati- 
cally redundant manipulators with 7 degrees of freedom (DOF) The control scheme 
consists mainly of proportional- derivative (PD,) controllers whose gains are adjusted by 
an adaptation law driven by the errors between the desired and actual trajectories. The 
adaptation law is derived using the concept of model reference adaptive control (MRACJ 
and Lyapunov direct method under the assumption that the manipulator performs non- 
compliant and slowly-varying motions. The developed control scheme is computationally 
efficient because its implementation does not require the computation of the manipulator 
dynamics. Computer simulation performed to evaluate the control scheme performance 
is presented and discussed. 


1 Introduction 

Considerable research effort has been spent to study kinematics and control of kine- 
matically redundant 1 manipulators [1]- [8] during the last decade. In [1], the problem of 
programming and control of redundant manipulators was investigated and the method 
of extended Jacobian was applied to optimize an object function. The concept of self 
motion was introduced by the authors of [2], who proposed a method to resolve the 
redundancy by directly controlling a set of self-motion parameters. The global op- 
timization problem of joint rates and kinetic energy in redundant manipulators was 
considered in [5], and the results of the global optimization results were compared with 
those of the local one. The method of pseudo-inverse was reviewed in [6] for application 
in redundant robots. Recognizing the challenging difficulties in the control of position 
and force because of redundancy, numerous researchers have focused their effort on 
developing control schemes for redundant robot manipulators. Cartesian-space control 
schemes were developed in [3] to control position/force of redundant manipulators, and 
in [4] to control a hydraulic redundant robot. Joint-space and Cartesian-space adaptive 
control schemes were developed in [7] and in [10], respectively for a redundant telerobot 
manipulator. Recently the so-called configuration control which utilizes the manipulator 
redundancy was introduced in [8] to control the manipulator configuration directly in 
task space. 

In this report, we first present the development of a Cartesian-space adaptive con- 
trol scheme for redundant manipulators. We then present and discuss the computer 
simulation performed to study the performance of the developed control scheme im- 
plemented to control the non-compliant motion of a 7 DOF redundant manipulator. 
Finally a conclusion will describe some current research activities and outline the future 
research direction. Matrix notations used in this report are: M T =transpose of the ma- 
trix M; 0„=(nxn) matrix whose elements are ail zero; I n =(nxn) identity matrix; and 
fr[M]=trace of matrix M. 


2 The Error-Based Adaptive Control Scheme 

Figure 1 presents the control scheme proposed for controlling the non-compliant motion 
of a 7 DOF redundant manipulator. As the figure shows, the actual joint variables 
measured by joint position sensors, axe transformed into the corresponding Cartesian 
variables via the forward kinematic transformation. The errors between the actual and 
desired Cartesian variables serve as inputs to a PD controller whose gains are adjusted 
by an adaptation law to be derived. The Cartesian forces available at the output of the 
PD controllers are transformed into the corresponding joint forces using the Jacobian 
transpose. 

The dynamics of the 7 DOF redundant manipulator performing non-compliant mo- 
lr The term "redundant” is often used instead of ’’kinematically redundant”. 
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( 1 ) 


tion can be expressed in Cartesian space as [10] 

F(<) = A(x, x) i(t) + <P(x, x) x(t) + r(x, x) x(t) 

where x(t) denotes the (6x1) Cartesian position 2 vector of the slave arm end-effector, 
and F(f), the (6x1) Cartesian force applied to the end-effector. A(x,x), a symmetric 
positive-definite matrix, #(x,x) and T(x,x) are of order (6x6) with elements that are 
highly complex nonlinear functions of x and x. 

The outputs of the PD controller constitute the Cartesian force vector F(t) computed 

by 

F(<) = K p (t) x e (t) + K d (i) x e (<) ( 2 ) 

where x e (t) given by 

x e (t) = x d (t) - x(t) (3) 

denotes the Cartesian error vector between the actual Cartesian position vector x(t) 
and the desired Cartesian position vector x d (t), K p (t) and Kj(t), are gain matrices of 
the proportional and derivative controllers, respectively. 

Substituting (2) into (1) yields 

A x e + (^ + K<i) x e + (r + K p ) x e = A x d + Xd + r x d (4) 

where the dependent variables of the matrices and vectors were dropped for simplicity. 
The state equation of (4) can be obtained by defining the state variable vector z (t) 

z (t)=[xj(t) xJ(t)] T . (5) 


so that from (4), we obtain 

z(t) = 


06 Og 

— Bi ~B 2 


z(t) + 


06 0e 0e 

B3 B4 16 


U (t) 


Bj = A l (r + Kp), B2 — A + K^), 
B 3 = A~ l r, B 4 = A - 1 4*, 


( 6 ) 

(7) 

(8) 

u (t) = [xj(f) xj(t) xj(t)] • ( 9 ) 

In order to achieve a minimal computational burden in real-time control, a reference 
model which characterizes the desired manipulator performance, should be selected as 

follows: 

x e i(t) + 2 x e i(t ) + a; 2 x e i(t ) = 0 (10) 

2 ^ this report, position implies both position and orientation and force implies both force and torque. 


where 

and 

and 
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where £, and u>; denote the damping ratio and the natural frequency of x et , and x ei ( t) for 
i=l,2,. . . ,7 are the elements of the tracking error vector x e (0 = [x el (<) x e2 (<) • • • ^MOl • 
As seen from Equation (10), the reference model is a Unear time-invariant system con- 
sisting of 6 uncoupled systems, each of which represents the desired error behavior in 

the corresponding Cartesian position. 

From (10), the state equation of the reference model can be obtained as 


®m(0 — ^ Z m(0 


06 16 

—A\ —A 2 


ZmW, 


( 11 ) 


where ^l 1 =diag(a;?) and ^ 2 =diag(2£,w,) are constant (6x6) diagonal matrices, and 



M0 = [ X m(0 i m(0] T 

(12) 

with 

\T 

Xm = (*^el %e2 • • * ^e6j * 

(13) 

Now solving (11), 

we obtain 



M0 = e- At Mo) 

(14) 


where the initial value of z m (<) is denoted by z m (0). Here if we assume that the initial 
values of the actual and desired Cartesian position and velocity vectors are identical, 
i.e. z m (0) = 0, then z m (f) = 0. Otherwise we can properly select & and so that all 
eigenvalues of A are stable to make z m (t ) ► 0 as t ► oo. 

Next the adaptation error vector E(t) is defined as 

E(<) = z m (0 — z(t). (15) 


Then from (6) and (11), an error system is obtained by 


m 


06 16 

—A\ —A 2 

06 06 

— B 3 — B,j 


m+ 





(16) 


Now a Lyapunov function u(t) is selected such that 


v(t) = E T PE + tr [(Bj -A 1 ) T !P r 1 (B 1 -^i)] 

+tr [(B 2 - A 2 ) T V 2 {B 2 - ^ 2 )] + tr[B^ 3 B 3 ] + tr[B^ 4 B 4 ], (17) 

where P and for i=l,2,. . . ,4, are positive definite matrices which will be determined. 
After differentiating (17) with respect to time and simplifying the resulting expres- 


sion, we arrive at 

v(t) = E t (P A + ^ r P)E + 2 tr [(B x - A^iY** + 1 F 1 B 1 )] - 2 tr [bJ(TxJ - tf 3 B 3 ) 
+2 tr [(B 2 - A 2 f(r^ T e + ^ 2 B 2 )] - 2 tr [b f(TiJ - * 4 B 4 )} 


(18) 
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where 

T = [P 2 P 3 ]Z(<) = -P2X e - P 3 X e 


(19) 


and P is given by 


P = 


Pi P 2 
P 2 P 3 


( 20 ) 


and we note that z m (t) = 0 results in E (t) = - z(t ). 

Now if £, and w, of (10) axe selected so that A is a Hurwitz matrix [9], i.e. all 
eigenvalues of A have negative real parts, then according to Lyapunov theorem , there 
exists a positive definite symmetric matrix P satisfying the Lyapunov equation given 

by PA + A t P = -Q ( 21 ) 


for any given positive- definite symmetric matrix Q. 

Now in (18) letting 

TxJ + = Txf + lP 2 B 2 = 0; TxJ - !P 3 B 3 = ^xj - = 0, (22) 


changes (18) to 

v(t) = -E r QE 

which is a negative definite function of E(t). Also from (22), we obtain 

b 1 = -v?Yx*-, b 2 = -i r?Y* T '\ b 3 = ^3 ^xj; b 4 = v: r'rxj. 


(23) 

(24) 


According to (17), since P is a positive definite matrix by properly selecting A and 
Q, the error system described in (16) is asymptotically stable if we can show that #7 
for i=l,2,. . . ,4, are also positive definite matrices. In other words, the adjustable system 
(6) will follow the reference model very closely, or z (t) approaches z m asymptotically as 
t — ► oo. 

Before proceeding, we assume that the end-effector of the manipulator performs 
slowly varying motion so that the elements of A, $ and P can be considered almost 
constant. As a result, from (7) and (8) we have 


Bi ~ A K 


p> 


A _1 K<i; B 3 ~ 0; B 4 ~ 0. 


(25) 


Substituting (25) into (24) yields 

A _1 kp = -iP^Txf; A~ l K d = 


(26) 


and 


0 0 ~ !P r 4 1 TxJ. 


Now in (26), if we let 


^i 




(27) 

(28) 
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where ft and ft are arbitrary positive scalars, and solving for K p and K d , we arrive at 

K p = ftTxf ; K d = ftTxf . (29) 

In (28), obviously ifh and are positive definite matrices that can be considered as 
nearly constant because A is positive definite and slowly time-varying. In addition, & 3 
and 1 P 4 should be chosen to be positive definite matrices whose determinants approach 
00 in order to satisfy (27). To achieve this, we can select ^3 and #4 to be diagonal 
matrices whose main diagonal elements assume very large and positive values. 

Now integrating both sides of the equations given in (29) results in 


K p {t) = K p (0) + ft + P 3 x e )xfdt 

(30) 

K d (t) = K d (0) + ft J (P 2 X e + P 3 Xe)xJcft 

(31) 


where K p (0) and K d (0) are initial conditions of K p (t) and K d (t), respectively and can 
be set arbitrarily. 

The development of the adaptive controller is now completed. As shown in (30) 
and (31), the adaptation law is designed based on the errors of the Cartesian variables 
of the slave arm end-effector and the submatrices of P. The adaptation law is very 
computationally efficient because P is a constant matrix and x e can be easily computed 
from the desired and actual Cartesian variables which are specified by the user and given 
from position sensors, respectively. Consequently, high sampling rates up to 1 KHz can 
be utilized in the implementation of the control scheme while the manipulator dynamics 
can be considered almost constant during each sampling interval of typically about 1 
ms. Another attractive feature is that the implementation of the control scheme does 
not require the computation of the manipulator dynamics, which is very difficult, if not 
possible to model accurately. 


3 Computer Simulation Results 

This section is devoted to report results obtained from the computer simulation con- 
ducted to study the performance of the developed Cartesian-space adaptive control 
scheme which was applied to control the motion of a RRC K-1607 robot manipulator as 
shown in Figure 2. The RRC K-1607, manufactured by Robotics Research Corporation 
is a 7 DOF kinematically redundant manipulator. The manipulator serves as a slave 
arm of a dual-arm telerobot system recently developed by Goddard Space Flight Center 
to investigate research issues in telerobotics such as advanced robot control algorithms, 
dual-arm teleoperation, end-effector design, and hierarchical control using high-level 
programming languages, etc. The slave arm motion can be controlled in a teleoperation 
mode by a human operator using the master arm system or autonomously controlled by 
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a set of computer programs. A complete analysis of forward kinematics and differential 
motion of the RRC K-1607 can be found in [11]. Following the convention in [12], 8 
coordinate frames are assigned to the manipulator as illustrated in Figure 2 showing the 
manipulator in its home configuration with all joint angles being zero. Each ith frame 
{i} is characterized by its coordinate axes x^, y,, z ^ and its origin 0, for i = 0,1,2,. . . ,7. 
The Denavit-Hartenberg parameters are given in the following table: 


i 

a t _i 

0|-1 

d, 

fa 

~T 

0° 

O.OOOin 

O.Oin 

0 1 

2 

-90° 

O.OOOin 

O.Oin 

fa 

3 

90° 

5.625in 

27.0in 

03 

4 

-90° 

4.250in 

O.Oin 

fa 

5 

90° 

-4.250in 

27.0in 

fa 

6 

-90° 

3.125in 

O.Oin 

fa 

7 

90° 

-3.125in 

O.Oin 

0 7 


Table 1 D-H parameters of the RRC K-1607 manipulator. 

For the simulation, and cjj for i= 1 ,2 were selected so that 2 characteristic roots of 
(10) are -1 and -2. Thus we have Di=2l7 and D2=3l7. Selecting Q, = I 14 for i=l,2,. . . ,7 
and solving (21) gives P2 — P3 = O. 25 I 7 . The adaptive controller gains can be now 
computed by substituting the derived values of P 2 and P 3 into (30)-(31) where K p (0) 
and K d (0) can be arbitrarily set. The scalars fa and fa can be adjusted to improve the 
tracking quality provided that they axe positive values. The payload was set to zero at 
the beginning of the simulation and suddenly changed to full payload of 10 lb at 1/3 of 
the simulation time and suddenly dropped to zero again at 2/3 of the simulation time. 
The sudden change in payload was modeled by delayed step functions. We considered 
two cases: tracking a straight line and tracking a circular path during a step change 
in payload. A modified version of Manipulator Simulation Program (MSP) [13] was 
employed for the computer simulation. 


Tracking A Straight Line 

Figure 3(a)-(b) present the results of the computer simulation in which the robot end- 
effector was controlled to track a desired straight line in the x-y plane of the base frame. 
The desired straight line is described by x(t) = Xo + 9[1 + 3exp( ^-t) — 4exp( ^-t)] 
and y(t) = y 0 + 9[2 + 6exp(-^f) - 8exp(-^f)] where the initial position is denoted 
by x 0 = 33.996m, y 0 = 0m. According to Figure 3(b), the maximum value of errors in 
x(f) and y (t) are 0.3473in and 0.1599in, respectively. In addition, the root-mean-square 
errors of x(t) and y (t) are 0.1536in. and 0.1047in, respectively. Computer simulation 
results also showed that position errors in z (t) and orientation errors were negligible. 
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Tracking A Circular Path 

Simulation results of the case in which the manipulator end-effector was to track a 
desired circular path in the x-y plane of the base frame are reported in Figure 4(a)-(b). 
The circular path consists of 3 segments described by x(t) = Rcos$ t ; y(t ) = -Rsin$, 
for f,_x < t < ti for i=l,2,3 where the circular path radius R = 24.32m, $i(f) = <j > o + f* 2 > 

$ 2 (<) = fa + u(t - h), and $ 3 (t) = <t> 0 - f(< 3 - w i th fa = °*' n ; fa = ^S ular 

velocity c o = ^-radian/ sec and the angular acceleration ft = ^-radian/ sec 2 . Figure 
4(b) shows that the maximum value of errors in x(t) and y(t) are 0.6551in and 0.6764in, 
respectively. Furthermore, the root-mean-square errors of x(<) and y(f ) are 0.2730in and 
0.3657in, respectively. According to the computer simulation results, position errors in 
z (t) and orientation errors were negligible. 


4 Conclusion 

In this report, an adaptive control scheme in Cartesian space was developed to control 
non-compliant motion of kinematically redundant robot manipulators having 7 DOFs 
or more. The development of the control scheme employed the concept of model refer- 
ence adaptive control and the Lyapunov theorem under the assumption that the robot 
end-effector performs slowly- varying motion. The control scheme was mainly composed 
of PD controllers whose gains are adjusted by an adaptation law to effectively react to 
dynamic and static coupling between joints and sudden change in payloads. Computer 
simulation conducted for two study cases; tracking a straight line and tracking a cir 
cular path showed that the developed control scheme provided good tracking quality 
with root-mean-square errors of about 0.16in for the straight line and about 0.36in for 
the circular path, despite step changes in payloads. Current research activities focus 
on implementing the developed control scheme to control the real-time motion of the 
RRC K-1607 manipulator. Experimental results on the implementation will be given 
in future reports. A hybrid control scheme is currently under development for simul- 
taneous control of position and force of redundant robots. In addition, utilization of 
the manipulator redundancy for avoidance of obstacles and joint limits is currently an 
active research area. 
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Figure 3(b) Errors in tracking a straight line (solid=x-error; dashed=y-crror). 



Figure 4(a) Tracking a circular path (solid=desirtd; dashed=aciua.l). 



Figure 4(b) Errors in tracking a circular path (solid=z- error; dashed=y-trror), 





